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Al: first flange O3DFC200f 

A2: second flange 
A3: second axis 
A4: first axis 

{Fig. 21 

Al; Take out worked work from work station 

A2: Input unworked work to work station > > > start working 

A3: Carry out worked work to carry out station 

A4 : Take out iinworked work (of next time) from carry in station 

[Pig. 3] 

11: instruction portion 

instruction data storing area 
parameter storing area 
interpolate operation portion 
drive portion 



12 
13 
14 
IS 



[Fig, 4] 

Al: START of look ahead processing 

101: interpret movement instruction and calculate movement 
time N etc» 

103: select flange constituting object of interpolate control 
104: control object is first flange? 
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105: third axis « 3A axis 

fourth axis = 4A axis 

f 1 axis = 3B axis 

f2 axis = 4B axis 
106: third axis - 3B axis 

fourth axis = 4B axis 

fl axis = 3A axis 

f2 axis = 4A axis 

[Fig.S] 

Al: START of current processing 
202: update K 

204: operate all axes to axis angle corresponding to 9 of 9 

9s + K/N (9e - 9s) 
205: execute interpolate control at first axis to fourth axis 
to orthogonal value corresponding to P of P = Ps + K/N (Pe - 
Ps) 

206: operate fl, f2 axes to axis angle corresponding to 9 of 
9 = Os + K/N {9e - Os) 

[Fig. 6] 

Al: MOVJ COOO 

FTP control to the attitude 
A2: first axis 
second axis 
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as": first flange side 
A4: second flange side 
AS: MOVL COOl FRG = 1 

^ linear interpolate on side of first flange 
PTP control on side of second flange 
A6: CP control by the axes 
A7: first axis 

second axis 

[Fig. 8] 

1: carry in station 

2: work station 

3: carry out station 

4: handling robot 

5 : hand 

Al: rxinning axis 

[Fig- 9] 

Al: Take out worked work from work station 

A2: Carry out worked work to carry out station 

A3: Take out unworked work from carry in station 

A4: Input unworked work to work station > > > start working 
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